/******************************************************************
简介：实现Mega2560扩展版控制爪子张开，闭合

爪子舵机引脚：4
******************************************************************/

#include "uni_servo.h"

UNI_SERVO_S servo(4); //声明爪子舵机引脚为4

void setup() {
  delay(1500);
  Serial.begin(115200);
  servo.init();     //舵机引脚初始化
}

void loop() {
  servo.move(60);   //爪子张开
  delay(1000);

  servo.move(120);  //爪子闭合
  delay(1000);
}
